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FIDUCIAL DESIGNS AND POSE ESTIMATION FOR AUGMENTED REALITY 

Roy T. Hashimoto 

FIELD OF THE INVENTION 

[0001] The present invention relates to digital image 
processing. More specifically, the present invention relates to 
image analysis using region segmentation, image moments, and 
f iducials . . : ' 

BACKGROUND- OF THE INVENTION 

[0002] The goal of most computer vision systems is to allow a 
computer to analyze and understand the scenes in ah image. 
Typically, ah image is analyzed to find features in the image, 
which can be recognized by the computer, vision system. Computer 
vision systems have typically been used for passive tasks such as 
mail sorting, tumor detection", parts identification, map making, 
and fingerprint matching . ' However, as the processing power of 
computer systems has improved interactive tasks using computer 
vision have been developed. 

[0003] . For example, computer vision can be used to determine 

r- 

the location and orientation, of a user in the environment of an 
augmented reality system. In conventional augmented reality 
systems a 3D virtual environment is displayed to the user using 
for example a head mounted display or a monitor. The 3D virtual 
environment changes based on the actions of the user. 
Conventional augmented reality systems typically use a user 
interface device, such as a joystick or ^ a mouse. However, if a 
camera is mounted on the user's head so that a computer vision 
system receives an image of what the user sees, the user's 
natural head movement can be used to control by the augmented 
reality system to determine the what part' of the virtual 
environment should be shown to the user. 
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[0004] Specifically, one or more markers, called fiducials, 
are placed in the actual physical environment of the user. 
Depending on the application, the fiducials could be placed in 
predetermined locations, on movable objects, or on fixed objects. 
The computer vision system must detect the fiducials and then 
analyze the fiducials to determine relative location of the 
fiducial from the camera. Using the relative location of the 
fiducials, the augmented reality system can determine the 
location and orientation of the camera. Because the camera is 
mounted to the user's head, the location and orientation of the 
camera is the same as the location and orientation of the user's 
head. The location and orientation of an object (e.g. the camera 
or the user 1 s head) is generally called the "pose" of the object. ' 
[0005] The process of identifying, and analyzing the fiducial 
to determine the pose of the camera mounted on the user's head is. 
very difficult. Furthermore, to provide adequate response to the 
user's- head movement, the pose of the user's head must be 
computed in real time. Generally, each frame of the video 
.captured by the camera, must be processed to identify and analyze 
the fiducials to determine the pose of the camera on the user's 
head. Hence. there is a need for a system and methods to 
efficiently process images having one or more fiducials. to 
compute the pose of the camera capturing the image. 

SUMMARY 

[0006] Accordingly , the present invention includes. novel 
methods to locate and analyze fiducials in an image. 
Furthermore, the present invention provides novel fiducials that 
can be more quickly located and analyzed. In addition, the 
present invention provides a fast. novel method of pose 
estimation. ' . 

j 
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[0007]' In some embodiments of the present invention, fiducials 
are located using a novel method' of region segmentation operating 
on a group of pixels called a "stick." The novel method is well- 
suited for modern general-purpose CPUs with SIMD" instruction sets 
and deep pipelines. Specifically, region segmentation is 
accomplished by dividing the image :into a plurality of sticks of 
pixels and determining whether . each stick belongs to any region 
from a set of region . Each stick that belongs to any region is 
classified as belonging to a specific region. In some 
embodiments of the present invention, the pixels of each stick 
are from a single raster line and are generally consecutive 
pixels of the raster line. 

[0008] Furthermore, some embodiments of the present invention 
incorporate a novel method for computing the undistorted moments 
of a region, i.e. the moments of the rectilinear projection of 
that region, without resampling the input image. This method 
for computing undistorted moments can be combined with the novel 
region segmentation method to perform segmentation and rectified 
moments calculation in a single pass through the image data . 
[0009] • In some embodiments of the present invention, novel 
fiducial (designs that are based on a plane circle, are used. For 
example, a fiducial pattern in accordance .with the .present 
invention may contain a circular main fiducial with an auxiliary 
fiducial. The auxiliary fiducial is encompassed by the circular 
main fiducial and is rotat i onally asymmetric with respect to the 
circular main fiducial. The main fiducial and the auxiliary, 
fiducial may be of ■ different colors. These designs can provide 
five or six degree of freedom poses' with a single fiducial using 
efficient closed- form solutions. A novel pose estimation method 
used to select the appropriate solution from the multiple 
solutions obtained, given certain application assumptions, is 
also disclosed. Specifically, a primary region Is used to 
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represent the main fiducial and a secondary region represents the 
auxiliary fiducial. A plurality of moments is calculated for the 
primary region. The moments are used to characterize the primary 
region as an ellipse. A plurality of parameters for a 5D pose 
based on the ellipse is calculated. Then, a 6D pose is 
calculated . using the 50, pose and the auxiliary fiducial. 
[0010] Other embodiments of the present invention may use a 
multiple fiducial pattern. The multiple fiducial patterns 
generally have multiple circular main fiducials arranged on a 
grid. Each circular main fiducial is distinguishable from each 
other. t The circular main fiducials could be distinguished based 
on color, by use. of auxiliary fiducials,. by use of identifying 
features, or other means. Pose estimation using the multiple 
fiducial pattern is accomplished by calculating a plurality of 
parameters for one or more 5D poses of a plurality of regions. 
The 50 poses are grouped into one or more planar groups. The " 
planar group with the most members is selected as the plane of 
the multiple fiducial pattern. Center differences are calculated 
for. each pair, of 5D poses. The orientation of the multiple 
fiducial pattern is based on the 5D pose with a center distance 
that most clo.sely equals the grid distance of the multiple . 
fiducial pattern'. Identifying features of the fiducials can be 
used to match regions to specific fiducials. 

[0011] ' The present invention will be more fully understood in 
view of the following description and drawings. 

BRIEF DESCRIPTION OF THE DRAWINGS 

[0012] Figure 1 is a high level flow diagram for fiducial pose 
estimation in accordance with one embodiment of the present 
•invention. 
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[0013] Figure 2(a) illustrates the grouping of pixels of an " 
image into sticks in- accordance with one embodiment of the 
present invention. 

[0014] Fig. 2(b) illustrates the regent segmentation scheme in 

accordance with one embodiment of the present invention. 

[0015] Figure 3 is a flow diagram for region segmentation .in 

accordance with one embodiment of the present invention. 

[0016] ■' Figure 4 is a flow diagram for region identification * in 

accordance with one embodiment of the present invention. : 

[0017] Figure 5 is a flow diagram for region identification in 

accordance, with another embodiment of the present invention. 

[0018] Figure 6 shows a grid of pixels sampled uniformly in 

image space mapped onto the- canonical planar projection 

coordinate system. . ■ ■■ ' 

[0019] Figure 7 provides a detailed view of the upper left ■ 

corner of Figure . 6 . ; 

[0020] Figure 8 is a flow diagram for the computation and 
accumulation of region data. . - ■ 

[0021] Figure 9 is a flow diagram for calculating a pose from 
a fiducial . , 

[0022] Figures 10(a), 10 (b) , and 10(c) shows three fiducial 
designs based on a planar' circle "in accordance with some 
embodiment of the present invention. • 

[0023] Figure 11 shows a multiple fiducial pattern in 
accordance with one embodiment of the present invention. 
[0024] Figure 12 illustrates identifying features as used in 
one embodiment . of the present . invention .. 

[0025] Figures 13(a) and 13(b) illustrates the decoding of 
identifying features in accordance with one embodiment of the 
present invention. 
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DETAILED DESCRIPTION 

[0026] " ■ Figure 1 is. a flow diagram showing the high-level steps 
for a process of fiducial pose estimation from a digital image. 
This flow: diagram is not specific to this invention. First 
objects in the- image are extracted in object extraction step 110. 
Then, the objects are analyzed to locate the fiducials of the 
image in locate. fiducials step 120. Then, in pose estimation 
step . 130, a pose is estimated for each fiducial found in the 
image. 

[0027] . Various conventional methods are available for object 
extraction step .110, locate fiducial step 120, and pose 
estimation step 130. . Embodiments of the present invention may 
use one or more of the conventional methods in combination with 
the novel methods described below. For example, in one 
embodiment of the present invention, conventional methods are 
used for object extraction step 110 and locate fiducial step 120 
.in combination with a novel method described . below for' pose 
estimation step 130. Other embodiments' include novel methods for 
object extraction step 110 and locate fiducials step 120 as 
described below . - 

[0028] A variety of methods can be used for. object extraction 
step 110. For example, pixel ■ labeling, run-length 
connectivity, and CAMSHIFT are conventional region , segmentation 
methods that can be used for object extraction step 110. 
Boundary-based approaches and region growing methods could also . 
be used for object extraction step 110. 

' [0029] However, most embodiments of the present invention use 
a novel region segmentation method for object extraction step 
110. Specifically, a digital image (which may be a single frame 
of a digital video) is processed by sequential raster lines. The 
direction of processing line is not critical; top to bottom . 
processing is described here without loss of generality. Each 
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raster line is processed sequentially by a group of consecutive 
pixels, called a stick. Generally, the number of pixels in a stick 
is constant for a given implementation, and is chosen "based on 
the operand size of the SIMD instruction set to be used. . For 
example, in one embodiment of the present invention, which uses 
the Intel MMX instructions, the stick size is chosen to be 8 
.pixels because 8 independent byte values can be processed with a 
. single instruction. .Again, the direction of processing sticks is 
not critical; left to right processing is described here without 
loss of. generality. The orientation of raster lines may be. 
horizontal or vertical; horizontal raster lines are assumed here 
without loss of generality. 

[0030] As used herein, the stick size S_S denotes the number /'. 
of pixels' in a stick, the image size I_S denotes the number of 
raster lines in the digital image, and line size L__S denotes the 
number of sticks in a raster line. 

[0031] As each stick is processed, a binary classifier is 
applied to its pixels, distinguishing which pixels in the stick 
are and are not part • of some region. Various binary classifiers 
can be used. For example, color, luminance, or some combination 
of color and luminance can be used as inputs to the binary 
classifier. The binary. classifier inputs could also be a single 
component of color or multiple components of colors. For 
clarity, the examples used herein use color as the basis to 
distinguish pixels. In some embodiments of the present 
invention, the binary classifier could be a threshold operation 
on one color component to produce a Boolean true result, 
indicating a pixel is part of a region, or a Boolean false 
result, indicating a pixel is not part of a region. In other 
embodiments, » the binary classifier could be separate threshold 
operations on multiple color components, which are then combined 
with Boolean operations to produce a true or false result. For 
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example, in a specific embodiment of the present invention, the 
binary classifier results are obtained by determining whether a 
first chrominance value is greater than a first threshold and a 
second chrominance value is less than a second threshold. Color 
components used may be in different color spaces in different 
embodiments , including RGB space and YCbCr space. For example, 
in one embodiment of the present invention the binary classifier 
is based onCb and Cr in YCbCr space because a camera used for 
this embodiment provides data in YCbCr space and the color 
channels are at a lower resolution than the luminance data. 
Using lower resolution allows faster processing. On some 
processor architectures, the classifier may be applied to several 
pixels, e.g. the entire stick, simultaneously in parallel. . 
[0032] If all pixels in the stick are classified as not 
belonging to any region, then the stick does not belong to any 
region. If one or more pixels in the stick are classified as 
belonging to a particular region, then those pixels will be , 
assigned to the same region. Note that pixels do not need to.be 
adjacent to ; be assigned to the same region, a difference from 
many other, segmentation algorithms that require., 4- or 8-connected 
-adjacency. Thus the segmentation results from the method, 
described herein are similar but not identical to the results of 
conventional image segmentation methods. 

[0033] In one embodiment of the present invention, region 
identifiers are used. to denote regions. The region identifiers 
are also used to access region data. The region identifier, 
which is generally a non-negative integer, can be used as an 
index into a region array. In another embodiment of >. the present 
invention, the region identifier is a pointer to a region 
structure. Because the use of pointers with data ' structures is 
well known, only the indexing is described herein. However, one 
skilled in the art can easily adapt the methods described here to 
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use pointers to a region structure. Region identifiers are used 
as new regions are encountered in processing the input digital 
image. If any pixels in a stick are determined to belong to a 
region, all such pixels will be assigned' the same region 
identifier . ... 
[0034] The region identifier assigned "to pixels within a stick 
depends on region identifiers assigned to previously, processed 
sticks. Fig. 2(a) illustrates dependencies for one embodiment .of 
the ' present invention. Specifically, Fig.' 2(a) illustrates a 
current stick S_X_Y and the some of the sticks processed before 
current stick S_X_Y of an image 200. The sticks in Fig 2(a) are 
referenced with respect to current stick S__X_Y. Specifically, 
sticks references uses the notation S_I_K, where I is the row 
position (i.e. the horizontal position within a row) and K is the 
raster . row. Thus stick S_X-1_Y is the stick preceding current 
stick S_X_Y on the same raster row. Conversely, stick S_X_Y-1 is 
the stick in the previous raster row in the same row position as ' 
current stick S_X _Y . Classification of current stick S_X_Y 
depends on stick S_X-1_Y (i.e., the stick preceding the current 
stick on the same raster row), stick S_X_Y-1 (i.e. -the stick on 
the preceding raster row in the same row position as the current 
stick),' and stick S_X+1_Y-1 (i.e., the stick in the previous 
raster row in the . row position following the current stick)., The 
region identifier assigned to the current stick S__X__Y is the 
earliest region identifier assigned to these previously processed 
input sticks, disregarding input sticks that either do not exist 
(because of the image boundary) or do not belong to any region. 
If no input stick belongs to a region, then the next unused 
region identifier is assigned to the current stick. Generally, 
conventional region' segmentation methods such as the pixel 
labeling method where sticks are not used and the region . 
identifiers of previously processed pixels are declared 
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equivalent and merged. For example, in conventional pixel 
labeling, if one pixel is assigned a region identifier 0 and a 
neighboring pixel is . assigned a region identifier 1, all pixels 
assigned to region identifiers 0 or 1 are declared to be 
equivalent,^ thus the two regions are merged into a single region. 
In the present invention, when multiple region identifiers are 
available, the earliest identifier is selected. 

[0035] Fig. 2(b) is used to illustrate the regent segmentation 
scheme in accordance with one embodiment of the present 
invention. Specifically, Fig 2 (b) shows an image 250 having 4 
lines labeled as lines L_0, L__l, L_2, and L_3 each having 16 
pixels labeled as pixels PJ,. P_l, P_2 ... P_15 . A stick S_M_N 
contains 4 pixels P_(M*4) , P_(MM)+1, P_(M*4)+2, and P_(M*4)+3 on 
raster line L_N, where M and N are integers in the range of 0 to- 
3, inclusive. Thus, stick S_0_.0, contains pixels PJ/PJ, P_2 
and P_3 of line L_0. Similarly, stick S_2_2 contains pixels P_8 , 
P_9, - P_10, - and P_ll, of line L_2. The value within the pixels 
boxes is the binary classifier input value for the pixel. For 
clarity, the binary classifier used to determine if a pixel is 
part of a region is simply a threshold test, with a threshold of 
100. Specifically, if the binary, classification input value of a 
pixel is greater than 100> then the pixel is part of a region. 
Otherwise the pixel is not part of a region. 

[0036] Analyzing stick S_0_0 finds that pixel P_3 of line L_0 
having a. binary classifier input value of 179 is part of a 
region. Because no previous sticks have been processed a new 
region identifier of 0 is assigned to stick S_0_0 . Because all 
the binary classifier input values of the pixels in stick S_1_0 
are zero, stick S_1_0 is not assigned to any region. Similarly, 
since all the binary classifier input values of the pixels in 
stick S__2__0 are zero, stick S_2_0 is not assigned to any region. 
However, in stick S 3 0, pixel P 13 of line L 0 has a binary 
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classification input value of 189 and should be assigned to a 
region. As explained above with respect to Fig. 2(a), the region 
identifier assigned to a current stick S_X__Y depends on the 
region identifier assigned to the previous stick of the same line 
(S_X-1_Y) , the stick in the previous line in the same position 
(S_X_ Y-l) and the stick in', the previous line in the next position 
(S__X+1_Y-1) . Because no previous' lines have been processed and 
stick S_2_0 was not assigned a region identifier, stick S_3_0 is 
assigned to a new region identifier, namely region identifier 1. 
[0037] In stick S_0_1, pixel P_2 of line L_l has a binary 
classifier input value of 201, and pixel P_3 of line- L_l has a 
binary classifier input value of 234. Thus, stick S _0_1 is part 
of a region. Because, stick S 0_0 (i.e. the stick in the 

previous- row in the same position as stick S_0 1 ) has a region 

i" • . 

■identifier of 0, stick 5 1_0 (i.e. the stick in the previous row 
in the next position as stick S_0_1) , does not have a region 
identifier, and there is no preceding stick of the same line, 
stick S_0_1 inherits the , lowest existing region identifier, i.e.. 
region identifier 01 

[0038] . In stick S_l_l, pixel P_4 of line L_l has a binary 
classifier input value' of 196, and pixel P__5 of line L 1 has a 
binary classifier input value of 198. Thus, stick S_l_l is part 
of a region. Because, stick S_0_1 has a region identifier of. 0, 
stick S_1_0 does not have a region identifier , . and stick S_2_0 
: does not have a region identifier, stick S_l_l inherits the 
•lowest existing region identifier, i.e. region identifier 0. 
Because all the binary classifier input values of the pixels in 
stick S_2_l are zero, stick S_l 0. is not assigned to any region. 
[0039]/ In stick S_3 1, pixel P_12 of line L_l has a binary . 
classifier . input value of 184, and pixel P_13 of line L_l has a 
binary classifier input value of 216. Thus, stick S_3_l is part 
of a region. Because', stick S__2_l does not have a region 
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identifier, stick S_3__0 has a region identifier of 1, and there 
does not exist a stick in the previous row in the next position, 
stick S_3._l inherits the lowest existing region identifier, i.e. 
region identifier 1. 

[0040] . In stick S_0_2, pixel P_2 of line L_l has a binary . 
classifier input value of 192. Thus, stick S_0_2 is part of a 
region. Because, stick S_0__1 has a region identifier of 0, 
stick S_l_l has a region' identifier of 0, and there is no 
preceding stick of the same line, stick S_0_1 inherits the lowest 
existing region identifier, i . e .-region identifier 0. 
[0041] In stick S_l_2, pixel P_4 of line L_l has a binary 
classifier input value of 189, pixel P_5 of line L_l has a binary 
classifier input value of ,212,. and pixel P_7 has a binary 
classifier input value of 200. Thus, stick S_l_2 is part of a 
region.. Because, stick S_l._l has a region identifier of 0/ stick 
S_2_i does not have a region identifier , and stick S_ 0_2 has a 
region identifier .of 0, stick S_l__2 inherits the lowest existing 
region identifier, i.e. region identifier 0. 

[0042]' In stick S_2_2, pixel PJ of line U has a binary 
classifier input value of 199 . Thus stick S_2__2 is part of a . 
region. Stick S_2_2 is adjacent to two regions. Specifically, 
stick S_l_2 has a region identifier of 0 and stick S_3__l has a 
region identifier of 1. As explained above when two. region 
identifiers could be used, the smallest region identifier is 
selected. Thus, stick S_2_2 is assigned a region identifier of 
0. Because all the binary classifier input values of .the pixels 
in stick S_3_2 are ' zero, stick S_3_2 : is not' assigned to any 
region. ' 

[0043] In stick S_0*'_3, pixel P_3 of line L_l has a binary 
classifier input ' value of 207. Thus, stick S_0_3 is part of a 
region. Because, stick S_0_2 has a region identifier of 0, 
stick S_l_2 has a region identifier of 0, and there is no 
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preceding stick of the same line, stick "Sj 3 inherits the lowest 
existing region identifier, i.e. region identifier 0. 
[0044] In stick S_l__3, pixel P_4 of line L_l has a binary 
classifier input value of 194. Thus, stick S_l_3 is part of a 
region. Because, stick S_l_2 has a region identifier of 0, stick 
S_2_2 has a region identifier of 0, and stick S__0_3 has a region 
identifier of 0, stick S_l_3 inherits the lowest existing region 
identifier, i.e. region identifier 0.„ Because all the binary 
classifier- input values of the pixels in stick S_2_3 .are zero, 
stick S_2__3 is not assigned to any region. 

[0045] In stick S_3_3, pixel P_13 of line L_3 has a binary 
classifier of input 191 and pixel P_14. of line L_3 has a binary 
classifier input value of 194. Thus stick S__3__3 is part of a 
region. Because stick S_2_3 does not have a region identifier, . 
stick S_3_2 does not have a region identifier, and there does not. 
exist a stick in the previous row in the next position, stick 
S_3_3 receives a new region identifier of 2. 

[0046] In one embodiment of the present Invention, an array of 
size L_S + 1 region identifiers is used to cache results from the 
previous line, and the region identifier at position i is denoted 
as line_id[i]. The region identifier assigned to the previous 
stick is denoted as' current_id. The region identifier of the 
next unused region identifier is denoted as next_id. Prior to 
processing the first line, next_id is set to the first region 
identifier, and all the elements of line_id are set to the last 
usable region identifier. Before processing the first stick of 
.each line, current_id is set to the last usable region 
identifier. Sticks are processed in raster order. When stick i 
of a line is processed, if the binary classifier results in no 
region, then current_id and line_id[i] are set to the last usable 
region identifier. If the binary classifier results ,in a region, 
then the region identifier for the stick is the earliest of 

13 
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line_.id[i], line_id[i + 1] , current__id, • and next_id. current^id 
and line_id[i] are set to the resulting region identifier , and if 
the resulting region identifier is equal to next_id . then next_id 
is set to the next unused region identifier. 

[0047] Figure 3 is a flow diagram illustrating the region 
segmentation method in accordance with one embodiment of the 
present invention. First, in image initialization step 310, 
next_id and array line_id are reset. Specifically,- next_id is 
set 'equal to zero and each entry in array line_id is. set equal to 
last region LASTJREGiON. In line initialization step 320, stick 
index i is reset to • zero and current_id is set equal to last 
region LAST_REGION. In stick classification step 330,- binary 
classification .is performed on each stick. Then in region 
identification step 340, the region ,is identified and process 
states (current_id, line__id[i], and next^id) are updated. Region 
identification step .340 is described in detail below with respect 
to Figures 4 and 5 . Region data is collected in. data collection 
step .350, which is- described below with respect to Figure '8 . If 
the current stick is not the last stick in a line, stick index I 
is incremented and processing returns to stick classification 
step 330.. If the, current stick is the last stick of a line, 
processing returns to line initialization step 320. Once all the 
sticks in all the lines are processed, error detection is 
performed in error detection step 360. In the embodiment of 
Figure 3, -if^the last region is used, an error is likely to have 
occurred. • 
[0048] Figure 4 is a flow diagram detailing one -implementation 
of the region. identification step 340 in accordance with one 
embodiment of the present invention. In pixel selection check 
step 410, whether any pixels in the stick were selected by the . 
stick classification step 330 is determined. If no pixels were 
selected, current_id is set to the. last region and processing is 
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passed to update array step 430. If any pixels were selected 
then current_id is set to the minimum region identifier of any 
previously processed sticks. Specifically, current_id is set to 
the minimum of line_id [ I ] , line_id [ 1+1] , current_id, or next_id. 
Then, in new_id check step 420, whether a new region identifier • 
is used is determined. Specifically, a comparison is made 
between current_id and next_id. If .current_id matches next_id, 
next_id is incremented by 1. If current_id does not match' 
next_id, next_id is not ' incremented. Finally, in update array 
step 430, the line_id array element is. set to current_id for . use 
in processing the next line. 

[0049] Figure .5 is. a flow .diagram detailing an alternative 
implementation region identification" step 340 in accordance with 
one embodiment of the present invention. First in initialization 
step 510, current__id is set to the minimum region identifier 1 of - 
any previously processed sticks. Specifically, current id is set 
to the minimum of line_id[I], line__id [ 1 + 1 ] : , current_id, or 
next_id. Then in pixel selection check step 520, whether any . 
pixels in the stick were selected by the stick classification 
step 330 is determined. If no pixels were selected, current__id 
is set to the last region and processing is passed, to new_id 
check step 530. If any pixels were selected then current__id is 
left unchanged and processing is passed to new_id check stop 530. 
Then, irf new_id check step. 530, whether a new region identifier- 
is used is determined. Specifically, .a comparison is made 
between current_id and next_id. If current_id matches next_id, 
next_id is incremented -by 1. If current_id does not match 
next_id, next_id is not incremented. Finally, in update array 
step 540, the line_id array element is set to current__id, for use 
in processing the next line. 

[0050] The methods of Figures 4 and 5 accomplish the identical 
calculation. However, the method of Figure 5' shows how the steps 
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can be reorganized for more efficient implementation on 
processors with significant penalties for branching, e.g. those 
with deep pipelines and/or speculative execution. The 
conditionals pixel selection check. step 520 and new_id check step 
530 only control whether a variable assignment is made, so they 
may be implemented with a' conditional move instruction where- 
available. The min() operation in initialization step 510. can 
also be implemented with conditional moves if a minimum 
instruction is not available. Conditional moves do not incur a 
branching penalty. Thus, region identification step 340 can be 
implemented without branching penalties. , 
[0051] APPENDIX I provides another embodiment of region 
segmentation in accordance with the -present invention implemented 
in pseudocode. One skilled in the art can easily adapt the 
pseudocode to implement region segmentation in accordance with 
the present invention. 

[0052] The method of region .segmentation described above with 
respect to Figures 3, 4, and 5 and' in Appendix I have several 
advantages as compared to conventional methods. For example/ the 
use of the last usable region identifier allows allocation of a 
fixed number of regions without a need to check for overflowing 
the number of regions in the inner loop. If the number of v 
regions detected in the digital image is greater than the number . 
of regions allocated, then next_id will be an invalid -region 
identifier after all the sticks have been processed. The data 
for the last' region may be incorrect, as it will be mixed with 
all subsequent regions/ but all preceding region data' will be 
correct and no out of bounds accesses will occur. -This use of a 
fixed number of regions and precluding the need for error 
handling makes this embodiment more suitable for hardware 
implementation. Furthermore because segmentation in accordance 
with the principles of the present invention can occur in one 
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sequential pass, each pixel only needs to be read once. Thus, 
the image does not need to be buffered for segmentation, which 
can result in cost savings by. minimizing memory requirements. In 
addition, segmentation in accordance with the present invention 
can be accomplished without conditional branching.. Conditional 
branching can stall pipelined processors which results in wasted 
processing cycles. Thus, segmentation in accordance to the 
present invention without conditional branching can be processed 
more rapidly than conventional segmentation methods. . 
[0053] However, the method of region segmentation described 
above with/respect to Figures 3, 4, and 5 and " APPENDIX I also has 
a few limitations. . One limitation is. that if regions are too 
close together, or if there is excessive noise in binary 
classification, pixels that should be assigned to different 
regions may be assigned to the same region. Therefore, regions 
should be separated by at least stick size N pixels in- the 
direction of the raster to be minimize possibility • of 
misclassif ication. Another limitation is that a single concave 
region may be split into two or more separate regions because 
raster lines- are processed sequentially in a single pass. 
Therefore, Regions should be convex, at least toward earlier 
raster lines, 1 or some post-processing step to merge concave 
regions can be applied to improve results. Another limitation is 
that sticks along the upper left edge of a region in some cases 
may not be properly assigned with the remainder of the region. ■ 
These errors decrease with, stick size N. Fortunately, there are 
many applications for which these limitations have negligible 
effect or can be avoided altogether. 

[0054] In the high level steps for a process of fiducial pose 
estimation from a digital image shown in Figure 1, some region 
information is obtained during object extraction step 110 and 
additional fiducial information is obtained in locate fiducial 
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step 120. Some embodiments of the present invention can use 
conventional methods ' such as finding the outline of contours, 
determining vertex locations for pose estimation, bounding boxes, 
or centroid averaging to locate fiducials in locate fiducial step 
120.. However, some embodiments of the present' invention are able 
to locate the fiducials within the object extraction step 110 
using the region segmentation method described above with respect 
to Figures. 3,. 4, and 5.' 

[0055J Once a region identifier is determined for a stick, 
data about the stick is added to the indicated r'egion's data 
. structure . The data may. include minimum or maximum line or stick 
index, and moments. .One embodiment uses moments of the form in • 
equation 1 (EQ01) . : 

M m „ = >- 0&« > 0 . EQ01 

. pixels 

where S(i, j) . is 1 or 0 if result of the binary classifier at row i 
and pixel j is true, or false respectively, p(i,j) is a weight for 
the pixel, x( i, 7) and y(i,j) are the pixel coordinates, and m : and 
n are the non-negative moment orders. . . * . 

[0056] Most photogrammetry (measurement using images acquired 
with a camera) algorithms assume that input images are uniformly 
and orthogonally sampled planar projections of a scene. In 
practice, images, acquired by real cameras may have lens 
distortions, different spatial sampling frequencies for rows and 
columns, or other deviations from an ideal planar projection. 
Camera calibration procedures provide the mapping from row and 
column samples to an ideal projection x(i,j) and y(i,j). This 
mapping is generally nonlinear in the presence of distortion. By 
convention, the canonical calibrated coordinate system for (x,y) 
places the origin (0,0) at the location of the center of 
projection (the projection of the optical axis) , and the distance 
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of an arbitrary (x,y) from (0,0) is the tangent of the angle the 
.projected ray through that point makes with the optical axis. 
[0057] Figure 6 shows' a simplified image grid overlaid onto 
the canonical coordinate system. The image is 8x8 with its . 
samples at the grid intersections. In the image coordinate 
system, the grid would be orthogonal with samples at integral 
values -of -i and j. In the calibrated coordinate system, the grid 
may be curved because of nonlinear undistortion mapping. The 
bowed-in appearance shown is typical (though exaggerated for 
expository purposes) of corrected barrel distortion. Note that 
the distance between samples (grid points) is larger when further 
from the origin. The pixel weight p{i,'j) can be considered the 
area of the image plane a sample, represents. The- sum of the 
pixels weights over all pixels should be the area of an ideal 
planar projection. If the camera calibration mapping is linear, 
p( i , j) is constant and may be determined by equation 2 (EQ02 ) . 



P = 



f dx dy\ 




( dx dy\ 


l~di , ~di) 







EQ02 



[0058] If the camera calibration is nonlinear, p{i,j) will not 
be constant but can still be approximated" with ' equation (EQ02 ) , 
by evaluating at every (i, j) . An alternative approximation 
chooses some method of tessellating the image plane into non- 
overlapping cells in such a way that each cell contains exactly 
one sample. The p(i,j) for any sample is approximated with the 
area of the corresponding cell . One such method defines 
quadrilateral cells formed with vertices computed from the 
weighted sums with neighboring sample coordinates, as in equation 
3 (EQ03) . Note that (x(i . j) , y(i, j) ) can be computed even if 
there is no sample at (i,j), so cells on the boundary of the 

sample grid do not require special handling. 
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j 1 0 

4 *" 01 - 1 ' EQ03 
... 4 A- 1/ -0 . 

1 1 1 

/ ^ A--0 /=0 

[0059] Figure 7 shows this geometrically by enlarging a ' 
portion of Figure 6. Vertex v 0 is the average of the four 
surrounding vertices 701, 702, 721 ,.. 722 . Vertex v; is the average 
of the four surrounding vertices 702, 703, 722, 723. Vertex. v 2 is 
the average of the four surrounding vertices 721, 722, 731, 732. 
Vertex v 3 is the average of the four surrounding vertices 722, 
723, 732, 733. The weight' p(i,j) for the sample at the 

common vertex 722 is the area of the quadrilateral defined by v 0 , 
V], V3, and • v 2 . .... 

[0060] Because p(i, j) , x(i, j) , and y(i, j) are invariant with 
image data, they can -be precomputed for any given calibrated 
camera and stored- in a table. The image moment calculation of 
equation (EQ01) can be expressed as a large inner product of the 
classifier vector with a precomputed coefficient vector' as in 
equation (EQ04) . ' ) 

Pixels EQ04 

[0061] APPENDIX II provides another embodiment of moment table 
generation in accordance with the present invention implemented 
in pseudocode. One skilled in the art can easily adapt the 
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pseudocode to implement moment table generation in accordance 
with the present invention. 

[0062] Figure 8 is. a flow diagram showing a moment data 
collection method that can be used in data collection step 350 
(Figure 3) . First in. load next moment coefficient step 810, the- 
next moment coefficient is loaded. Then in coefficient masking 
step 820, the coefficient is masked depending on the result of 
the classifier. Specifically, the coefficient is unchanged when 
the classifier true and the .coefficient is changed to zero of the 
classifier is false. . The result' is accumulated to the region 
identified by segmentation, with separate accumulators in the 
region data structure for each moment in region data- accumulation 
step '830 . Load next. moment coefficient step 810, coefficient 
masking step 820, and region data accumulation step 830 is. 
repeated for each moment. Generally, all .the pixels in a stick 
can be processed in parallel. 

[0063] In practice, masking the coefficient may be done either . 
by representing the classifier', r.esult as . a bitmask of all ones or 
all zeros and issuing a bitwise AND with the coefficient, or by 
representing the classifier result with a 1 or 0 and multiplying 
with the coefficient. Although the Boolean operation has lower 
latency on most processors, e.g. 1 cycle vs. 3 cycles on Intel 
Pentium III;, some processors have mult iply-accumula te 
instructions that result in greater throughput by combining part 
or all of the work in coefficient masking step 820. and region 
data accumulation step '830. ■'■ 
[0064] This formulation has two important advantages. The 
first and more important advantage is that the moments that 
result are the statistics of an ideal projection in the 
calibrated coordinate system, not the original uncalibrated 
image. Although linear corrections may be applied to 
uncalibrated moments, nonlinear corrections cannot. Most 
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inexpensive • wide ' angle digital image and video cameras require' 
nonlinear correction. The second advantage is that calculating 
moments as inner products maps very well onto many SIMD 
instruction sets, particularly, those with a multiply-accumulate • 
operation, and thus can be implemented very efficiently. 
[0065] A fiducial is a known object placed in a scene to 
provide a landmark position, orientation, scale, or other control 
data. Some embodiments of the invention use a fiducial 1010 
having' a planar circle 1012 on - a planar background 1014 as shown 
in Figure 10(a). Planar circle 1010 and planar background 1020 
are distinguishable from each other with the binary classifier. 
In general better results are obtained if planar circle 1010 is 
also distinguishable from the remainder of the environment, or is 
more prominent than other objects. Planar background 1020 can be 
omitted if it is. known that, nothing in the environment will 
confuse segmentation, but -this is generally not advisable. 
[0066] This fiducial design works well with the region 
segmentation methods described above. If multiple instances of 
fiducial 1010 are used, planar background 1014 can be made large 
enough so that : the instances of planar circle 1012 are located in 
separate regions. . The projection of a circle remains convex 
under any practical camera distortion function and parameters, so 
planar circle 1012 circle will be recognized as a single region. 
The tangent to the projection of a circle varies continuously, 
which limits misassignment on the upper left edge. 
[0067] A pose is the position and orientation of an. object 
relative to the camera coordinate space. A pose has 6 degrees of 
freedom, which are typically considered as 3 rotational degrees 
of . freedom (e.g.. roll, pitch, and yaw) and 3 translat ional 
degrees of freedom (e.g.- x, y, and z) . Pose is often expressed 
as 'a 4x4 matrix /that expresses the transform from object space to 
camera space. 
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[0068] Embodiments of the invention can use a single fiducial 
with no subregions to determine pose to five of the six degrees 
of freedom if the application can make some assumptions about 
fiducial placement. In particular, this can work if the fiducial 
is kept horizontal and viewed from above. A circle has one free 
rotational degree of symmetry, so rotation about the plane normal 
is a free parameter that cannot be uniquely determined without 
additional features. .-■ 

[0069] Figure 9 is a, flow diagram showing one embodiment of 

■ . ■ * ^ ' ■ X 

pose estimation step 130 (Figure 1) . The projection of a 

circular fiducial is an ellipse which is determined from- moments . 

in compute ellipse step 910. The, ellipse is used to solve for 

five parameters of a pose in - 5D pose solve step 920 as described 

below. Multiple solutions, are generated in 5D pose solve step 

920. In solution selection step 930 the CQrrect solution is 

selected as described below. If auxiliary . f iducials are used, 

optional 6D pose solve step 940 may be used to fix the final 

degree of freedom in the pose. 

[0070] The method of pose determination requires computing 
moments M 00 , M 10 , M 0 i, M 2 q, M 02 , and Mn for ' the" -fiducial circle. In 
one embodiment, this is accomplished by computing the moments for 
. all regions in the digital image and determining which region is 
the fiducial. If the fiducial is usually prominent in the 
application, this may be determined by. choosing the region with 
the largest M 00 . Since M 00 is proportional to area, this is : 
equivalent to choosing the region with largest area. 
[0071] The planar projection of the fiducial circle will be an 
ellipse. The .ellipse parameters - center; {x c , y c ) , semi-axis 
lengths a and jb, and orientation 6 (angle the major axis makes 
with the x-axis) - can be determined from the six moments 
collected. The center (x c ,y c ) is simply the'centroid of the 
region, as computed in Equation • 5 (EQ05) . 
• • ' 23 
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EQ05 



[0072] The second order moments are adjusted to be relative to , 
the region centroid instead of the Image origin by using the 
parallel axis theorem. This is demonstrated in Equation 6 
(EQ06) . : • 



Mo2= M Q2 -y 2 c M OQ 

Mil = ^u-yAo 



EQ06 



[0073] The orientation 0 can be computed from the adjusted 
second order moments .as shown in Equation 7 (EQ07 ) . 



9 = ~'dvctm 2//n — EQ07 

Finally, semi-axis lengths a and jb are computed as shown in 
Equation 8 (EQ08) . . 



v 20 = ju 2Q cos 2 0 + ju 02 sin 2 0 + 2ju u cos 0 sin # 
v Q2 = // 20 sin 2 ^ + // 02 cos 2 ^-2// 11 cos^sin^ 




EQ08 



[0074] - Given the ellipse equation and the knowledge that it 
results from the projection of a circle of unit radius, the 
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ellipse is expressed in the matrix form for a conic as shown in 
Equation 9 (EQ09) : 



" cos 2 0 sin 2 0 



a 



cos 0 sin 0 



J 



_ sin 2 6^ cos 2 0 

C = . + _ 
a 2 6 2 

D^^Ax c -By c 
E = -Cy c -Bx c 
F = Ax 2 c +Cy 2 c +2Bx c y c -l 

~A B D 
Q= B C E 

D E F 



EQ09 



[0075] The eigenvalues ; and eigenvectors of Q are determined - 
eigenvalues A lf A 2 , and A 3 , in increasing value, and . eigenvectors 
e-i, e 2 , and e 3 , in corresponding order - 

[0076] The normal n to the fiducial plane in the camera 
coordinate system is computed as shown in Equation 10 (EQ10) . 



<P = ±arctan 



1 


-4 




-4 



n - 



e 2 £ 3 



cos cp 0 sirup 

0 10 (0,0 9 l) r 
-sirup 0 cos^_ 



EQ10 



[0077] As noted in the references/ there are multiple possible 
solutions with this computation. One ambiguity is the sign in 
the formula for <p, which arises because either the positive or 
negative square foot may be used. In addition, the. signs of the 

eigenvectors are independently arbitrary. These ambiguities 
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allow up to four distinct solutions for Q (two anti-parallel 
vector pairs) 

[0078] For certain applications, only one of the fiducial 
orientations corresponding to the solutions for n will be 
expected.. For example, if the fiducial is known to-be horizontal 
and the camera is kept generally upright, then only one of the 
solutions will be appropriate. For this, solution, the normal n 
will point opposite the camera optical axis and in the same 
direction as the camera . up vector . For example, if the camera 
coordinate system is such that the optical axis points in the , 

( 0 , 0 , -1 )• direction and the up vector is (0,1,0), then the correct 
n is the one with positive y and z components. 

[0079] r The location of the center c of the fiducial in camera 
coordinates may be found as shown in Equation 11 (EQ11 ) , in which, 
.the sign of a on the last line is chosen to be the same as the 
sign of (p in Equation 10 (EQ10) (r is the radius of the circle) . 



rf = Jr 



-4 



A 2 



C == 



cos#> 0 sin <p 

0 1 0 
-sirup 0 cos^ 



(±a,0,d) T . 



EQll 



[0080] The computed centers of auxiliary f iducials may be 
determined by the same or different means than, that previously 
described. Any different means may use the five known degrees of 
freedom from one fiducial as additional input information. 
[0081] Another method of fixing the final degree of freedom is 
to use an auxiliary fiducial with a strong orientation on the 
image plane, such as. a thin rectangle or ellipse. Two points 
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along the- auxiliary fiducial major axis on the image plane are 
found. A complete matrix transform T from object space to camera 
space may be constructed as shown in Equation (EQ12 ) , where p and 
q are the 2D points homogeneously extended to 3D by appending a 1 
as the z/w coordinate, i.e. (p x , p y ) - becomes (p x , p y/ 1) and (q x/ 
q y )' becomes (q x , q y , 1 ) . : . .... 

c-n 

s = ^-^~ - 
p-n 

en 



t = 
q-n 

tq-sp 

u = ~ EQ12 

Mq. — sjpj 

v = nxu 

u v n c 

0 0 0 1 



[0082] 'Finding two. points that define a major axis of the 
auxiliary fiducial can be determined by several image analysis' 
methods. One convenient method is to use the same region 
segmentation and moment calculation machinery as the main 
fiducial (with a different binary classifier) . The centroid of 
the auxiliary fiducial, computed using Equation 5 (EQ05) , is one 
appropriate point. The second point can be generated by adding 
the scaled orientation vector [e cos 0, s sin.0) derived using 
Equation 7 (EQ07 ) to the centroid, where £ is a small scaling 
factor. The scaling factor is needed to keep the .projection of 
the second point onto the fiducial plane in front of the camera. 
[0083] In both methods' using auxiliary fiducials, auxiliary 
fiducials can be placed within the bounds of . the main fiducial.- 
Any such auxiliary fiducial should not extend outside the border 
of. the main fiducial, and their position should be rotationally 
asymmetric. Since the main fiducial serves as the background for 
auxiliary fiducials, auxiliary fiducials must be distinguishable 
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from the main fiducial/ typically by color. Figure 10(b) shows a 
fiducial 1020, which includes a planar; square background 1024, a. 
planar circle 1022 (i.e., "the main fiducial"), and an auxiliary 
circular fiducial 102.6 of contrasting color, with a smaller 
radius than planar circle 1022. Auxiliary circular . fiducial 
1026, is placed off-center and within the planar circle 1022, all 
on planar background 1024. As, illustrated in Fig . 10(c), in 
another embodiment of the present, invention, a fiducial 1030 
includes a planar circle 1032 (i.e., "the main fiducial" ) on a 
planar, background 1034 and a auxiliary, thin . rectangular fiducial 
1036 of contrasting color; Auxiliary thin rectangular fiducial 
1036, which has a length that is smaller than « the diameter of • 
planar-circle 1032, is placed off-center and within planar circle 
1032 on planar background 1034.- Planar background 1024 and 1034 
.can be omitted if it is known that nothing in the scene will . 
confuse segmentation, but this i's generally not advisable. 
[0084] • Embodiments of the present invention segments and' 
computes moments for the main fiducial (i.e.- the large circle), 
including all enclosed auxiliary fiducials . This- can be done in 
either one or two passes. The one-pass approach is to use a 
binary classifier that selects both main and auxiliary fiducial 
pixels. The two-pass approach uses a different binary classifier 
on each pass. The first pass segments and computes moments for 
the. main fiducial excluding the enclosed auxiliary fiducials. 
The second pass segments and computes moments for the enclosed 
auxiliary fiducials. The corresponding moments are summed to get 
the moments for the main . fiducial including the enclosed 
auxiliary fiducials, taking advantage of the linear property of 
moments. The two-pass approach is likely to be superior, because 
the one-pass binary, classifier is likely to be more complex and 
because the moments for the auxiliary fiducials will be used 
separately • 1 
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[0085] There are several advantages to this design of 
incorporating auxiliary fiducials within a main fiducial with 
rotational asymmetry. First, the asymmetry allows determination 
of all six degrees of freedom. In addition, placing auxiliary 
fiducials within v the bounds of the main fiducial" places, fewer 
limits on usable camera positions, because multiple separated 
fiducials do not have to be in view, only the main fiducial. 
Finally, finding the; bounds of the main fiducial in the first 
pass can be used to restrict the search and analysis for 
auxiliary fiducials in the second pass, which can improve 
performance. ,'< 

[0086] Some embodiments of. the. present invention use' a 
multiple fiducial pattern rather than a single fiducial. 
Generally, multiple fiducial patterns are used when the camera 
view is not expected to keep a single fiducial in view. A 
properly designed pattern can. allow pose determination from a 
subset of the fiducials, and can accommodate' fiducials entering 
and leaving the field of view as the camera position and/or 
orientation is changed. • 
[0087] Fig. 11 shows a multiple fiducial pattern 1100 .that can 
be used with the region segmentation process of this invention, 
which performs object extraction' and locates the individual 
fiducials of the multiple fiducial pattern. Specifically, Fig . 
11 is a grid of circles C_0_0 , C_0_1,. ... C^3_3 having identical 
radii. Each circle serves as a main fiducial in the multiple 
fiducial pattern. Generally, the fiducials of a multiple 
fiducial pattern are distinguishable from each other. For 
example, in one embodiment of the present, invention, each main 
fiducial is a different color. In another embodiment, each main 
•fiducial encompasses an auxiliary fiducial that uniquely 
identifies the main fiducial. ) 
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[0088] In one embodiment ' of the present invention, the region 
segmentation process returns statistics for each fiducial seen by 
the camera in a single pass. The process described above for the 
single fiducial situation is repeated on each fiducial seen by 
the camera to generate a 5 degree of' freedom pose for each 
fiducial seen by the camera. However, the disambiguation step 
that selects one .of the two pose solutions can be skipped, 
allowing two 5 degree of freedom poses for each circle "because 
further processing rejects poses that are not consistent with the 
multiple fiducial, pattern. . ■ • 

[0Q89] The pose estimation process provides a set of fiducial 
centers and normals. Some of these poses correctly represent ' the 
fiducials on the grid. However, other' poses may be incorrect due 
to segmentation errors, in complete fiducials at the edge of an 
image, or being the incorrect solution to the pose problem. 
These incorrect poses must be removed from consideration. . 
[0090] In one embodiment of the present invention, poses are 
separated into groups that approximately. represent the same 3D 
plane, i.e. all poses in a group have the same normal to within 
some tolerance and the- centers are on the same plane to within 
some tolerance, with the following procedure. An initially empty 
list of planes, where a plane is - defined with a normal Np and a 
point on the plane Pp, is created. Each pose, which consists of 
a normal Nc and a center Pc, is tested for the first match 
against the list of planes by satisfying Equation 13a (EQ13a) , 
Equation 13b . (EQl3b) , and Equation 14 (EQ14). 

(Nc-Np) 1 > Kn ' EQ13a 



((Pc-P P ).N P l <Kp EQ13b 



Pc-Pp\ 
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[0091] In a particular embodiment of the present invention/ a 
value of- 0.98 for Kn and a value of 0.01 for Kp has. been used. 
If the pose does not' satisfy the inequalities for any plane on 
the list, then a new plane is added to the list with Np equal to 
Nc and Pp equal to Pc. Each pose is thus assigned to a plane 
group . ' • 

[0092] The distance between the centers of each pair of poses 
is examined. The pair with a distance closest to the grid 
distance g is used to estimate the grid orientation.- The 
normalized vector from one center of the pair to the other is 
used as one characteristic direction u of the grid. The other 
characteristic direction vis computed with the cross product Np x 
u. • ' ' 

[0093] The plane group with the most poses is assumed to be 
the plane of the multiple fiducial pattern. All other poses are 
rejected and removed from further consideration. Then a 
correspondence between each remaining pose and a grid point is 
established. First a pose center Pc is .chosen arbitrarily to be 
the origin/ Z . For each pose, the corresponding grid indices (x, 
y) are chosen by Equation 14 (EQ14 ) 

(x,y) = (round((Pc~Z)--)g,round((Pc-Z)-~^^ EQ14 

v s \ z J 

where round (x) returns the nearest integer to x, , 'and g is the 
grid distance between circles. 

[0094] . At this point there is a set of corresponding grid 
indices (x/y) and circle centers Pc. The approximate transform T 
that maps coordinates in grid space [xg yg 0 1] to world space is 
shown in Equation 16 (EQ16) . 
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u 0 

v 0 

Np 0 

Z 1 



EQ16 



[0095] The quality of- the transform of Equation 16 (EQ16) 
depends on camera resolution, low noise, etc. An optional 
transform refinement may be done by using this transform as an 
initial estimate to a conventional pose estimation algorithm that 
uses nonlinear optimization, to determine a pose that is least 
squares optimal. This method uses T to transform grid points 
into camera space. An error function is defined as the sum of 
squared distances between the transformed grid points projected 
into screen space and the observed centers' Pc also projected into 
screen space. The transform T is iteratively adjusted, using the 
multidimensional Newton's method,., to minimize the error. 
Newton' s method converges quadratically provided that the initial 
choice of T is close enough to the, optimal value. The 
calculation of T described here has been observed to be more than 
adequate for convergence in practice. ■ 
[0096]- . Transform T of Equation 16 (EQ16) does not uniquely 
relate the observed fiducials to the multiple fiducial pattern 
because the origin Z was chosen arbitrarily . Therefore, the 
observed fiducials may be offset from by an integer number of 
grid positions. Similarly, because the grid direction can be set 
from any adjacent pair of fiducials, the orientation can be 
rotated from one solution to another by a multiple of 90° about 
the plane normal. Additional information is required to keep the 
solution consistent, to fix the grid origin and axes. 
[0097] * In one embodiment of the present invention, additional 
identifying features are added to the multiple fiducial pattern 
to help determine the -true origin and axes of the. multiple 
fiducial pattern. The identifying features should be distributed 
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over the multiple fiducial pattern, so that the identifying 
features may be seen whenever a usable subset of the multiple 
•fiducial pattern is visible. In addition, the identifying 
features should not interfere with, the fiducial pose estimation 
process. For example, in general the identifying features should 
not overlap the f iducials . Furthermore, the identifying features 
should be locatable . and . interpretable under any arbitrary offsets 
and orientations possible in transform T of Equation 16 (EQ16) . 
[0098] In some embodiments of the present invention, the 
identifying features are placed near each' fiducial in the 
multiple fiducial pattern. Because the identifying fields 
accompany each fiducial, the identifying features are ' visible ■■ 
whenever, multiple f iducials are visible. Generally, the 
identifying marker should be easily distinguished from the 
f iducials. Thus, in some embodiments of the present invention, 
the identifying markers are a different color than the f iducials . 
In a particular embodiment of the present invention- the f iducials 
are red circles and the identifying features are black polygons. 
[0099] The identifying features around each fiducial should be 
unique (i.e. different from the identifying features around any 
other fiducial). Using unique identifying feature for- each 
fiducial identifies the offset of the fiducials from the true 
origin of the multiple fiducial pattern. Furthermore, the 
identifying features should be asymmetric, i.e. not the same as 
any ^identifying features of this or any other fiducial when 
rotated by a multiple of 90°. The' asymmetry of the Identifying 
features identifies the true grid axes. 

[0100] Figure 12 illustrates the identifying features used in 
one embodiment of the present invention. For the embodiment of 
Fig. 12, a circular fiducial 1210 is surrounded by 16 square 
Identifying features AO, Al, A2, A3, A4,.B0, Bl, B2, B3, CO, CI, 
C2, C3, and DO, Dl, D2, D3. Each identifying feature is 
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interpreted as a bit, either filled with the background color for 
binary 0, or filled with a. color different from both the 
background color and the color circular fiducial 1210' for binary 
L The bits are grouped into four binary numbers A (A3 A2 Al 
AO), B (B3 B2 Bl BO) f C (C3 C2 CI C0) r and D (D3 D2 Dl DO).'. In 
the correct orientation, the grid indices are ( A , B ) , and the 
values C-A+l and D=B+1.- Thus, in the correct orientation, the 
binary value on the right edge is one more than the binary value 
on the left edge, and the binary value on the top edge. is. one 
more than the binary value on the bottom edge, 

[0101] Figure 13(a) shows an example. of a' circular fiducial ' 
with. the appropriate identifying features shaded black. In 
Fig. 13(a) A is 2 (0010b) , B is 2 (0010b), C is 3 (0011b) , and D 
is 1 (0001b). In the correct orientation, D should be equal to 
B+l. However in Fig. 13(a), D does not equal B+l. Thus the 
orientation of Fig. 13(a) is not correct. However as illustrated 
in Fig. 13(b), if Fig 13 (a) is rotated 90° .counterclockwise (-90° 
clockwise), the proper relationship of C.and D relative to A and 
B are achieved. Specifically, A is equal to 1 (0010b),. B is 
equal to 2, C is equal to A+l, i.e. 2, and D is equal to B+l, 
i.e. 3. Therefore, fiducial 1310 is the fiducial at grid 
position (1, 2).. In Fig . 13(a) the identifying features indicate 
that the multiple fiducial pattern had been rotated -90° 
counterclockwise (90° clockwise) . 

[0102] There are identifying features, that can be used with 
different embodiments of the present invention. For example, one 
embodiment of the present invention uses different colors in the 
identifying features to help distinguish one fiducial from 
another. Furthermore, error-detecting or error-correcting codes 
may be used to prevent misreading the markings. 
[0103] The final pose matrix P relative to the true grid 

origin, when the arbitrarily chosen origin is ■ found to have grid 
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indices (i,j) and rotated by an angle 0 (a multiple of 90°) , is 
given in equation 17 (EQ17) 

1 \- 0 0 OTcosfl ^sin<9 0 0 

0 1 0 0 sin# cos£ 0 0 

P = 

4 0 0 1 0 0 0 1 0 

rig: -jg o ij[ o o o i 

[0104] The present invention includes a novel, and efficient 
region segmentation method arid a novel calibrated moment - 
calculation method that can be independently used together or 
independently in many .image v processing and computer vision 
applications. The methods described herein process image data in 
a single pass per classifier and can be implemented without 
branching except for loop control, thus the methods are suitable 
for parallel and hardware implementation . Different embodiments 
of the present invention may use the set of moments detailed 
here, or different choices of moments. For example, in dne^ 
embodiment of -the present invention, 0 th and 1 st order moments are 
chosen when only region centroids are required. In another 
embodiment of the present invention, moments through 3 rd or -4 th 
order may be chosen to calculate Hu invariants, used in pattern 
recognition. Because the methods described herein do not' require 
initialization from previous' frames, the methods can be used on 
single images and in video applications even when frame to frame 
coherence .is not guaranteed. 

[0105] In some embodiments of. the present invention, region 
segmentation and/or moment calculation are implemented in the 
same device as a camera. . The limiting resource on some computer- 
vision systems is. the data bandwidth from the camera to the 
computer, which impacts both latency and throughput. Processing 
image data' into region data and transferring only the region. data 
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would allow a substantial reduction in required bandwidth if the 
image data is not further required. 

[0106] By combining the methods .described herein, the pose of 
a single fiducial can be determined under certain assumptions 
that allow the correct' pose from multiple solutions to be 
discriminated. One sufficient set of assumptions is that the .." 
fiducial is horizontal and the camera does not look down past the 
vertical . . 
[0107] The present invention is well-suited for augmented 
reality applications that do not involve physical interaction 
with the real or virtual objects in view, which is sometimes 
called fishtank virtual reality. This allows the use of a single 
fiducial/ since user movement will not obscure it. . A camera is 

.attached^ to the user's head, and the invention is used to track 
the position of the user relative to the fiducial. 3D graphics / 

.are displayed to- the user, compensating for head motion. The 3D 
graphics may be shown on a head-mounted display or on a monitor, 
with or without stereo. A head mounted display allows the user 
to change the presented view using natural head movements instead 
of being moderated through a user interface device like a mouse 
or' j oystick . 

[0108] In one embodiment' of the presents invention, a fiducial 
or fiducials can be realized directly on the ease' of a portable 
computing device that implements the pose estimation and 
generates 3D graphics. The user can move his head or a control, 
device in order to change the view. In another embodiment, ttie 
fiducial may tie. mounted on an embedded turntable that can be 
rotated to change the fiducial orientation . From the point of 
view of the user, the graphics are drawn with a consistent 
spatial relationship to the fiducial or fiducials. For example, 
a fiducial is attached to a small computing device with, a head- 
mounted display. 3D virtual objects are drawn so that they - 
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appear to be on top of the fiducial. The view may be wholly 
virtual, or may include real objects either by optical ' or video 
means . ; <- : ; 

[0109] In the various embodiments of this invention, novel , 
structures and methods have been described for region 
segmentation, region characterization, and pose estimation. In 
view of this disclosure, ' those skilled in the art can define " 
other fiducial patterns, multiple fiducial patterns, sticks, 
regions, binary classifiers, threshold levels, color components, 
moments, weighting tables, main fiducials, auxiliary f iduci.a Is, 
identifying features, poses, planar groups,- plane normals, pose 
normals, center differences, and so forth, and use these 
alternative features to create a method or system according to 
the principles of . this invention. • Thus, the invention is limited 
only by the following claims. 
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APPENDIX I 

Copyright (c) 2003 Shoestring Research, • LLC 
. AH Rights Reserved 

// initialize region ID buffer to last region ID 
for ( int j ■= 0; j <=f ImageWidth/S tickSize ; ++j )v 
line id [j ] ■= LastRegionID; 

// initialize region data 

for ( int k = 0; k <= LastRegionID; ++k ) 

{ \ ' • ■ • ' . . . ■ . 

//. reset moment accumulators to .zero 
momentOO [k] = 0; 
moment 10 [k] = 0; 
moment 01 [ k] = 0; 
moment 20 [k] - 0; 

moment 02 [k] ' = 0; 1 : 
moment 11 [k] = 0; 

:. // reset region bounds 

topmost_' line [ k] = ImageHeight; ' • • 

lef tmost_stick [k] = ImageWidth/ S ticks ize; 

} ' ; . y " : : ■ 

// initialize next available unused ID 

next_id = 0 ; * ; ■ 

.// loop -over image lines 
for ( int i =0; i < ImageHeight; ++i ) 

{ . ~ 

// initialize previous stick ID to next available unused ID 
current_id =. next_id; 

// loop over sticks in the line 

for ( int j =.0; j < ImageWidth/StickSize; ++j ) 

{ ' 

// classify the stick, producing a vector of StickSize 1 
and/or 0s 

class_vector = BinaryClassif ier (stick [i] [j j) ; 
// determine the conditional region ID 

// min() is, a function that returns the minimum of its 
// arguments . . 

current_id = min (current_id, line__id [ j ] , line_id [ j +1] ) ; . 

. // update state depending on if any pixels classified 1 
if .( class_vector == 0 ) // no pixels classified 1 
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current_id = next__id; 
line_id[j] = LastRegionID; 

// remainder of loop may be optionally skipped here 

} 

else // at least 1 pixel classified 1 

. { » ; 

: line_id[j] > current _id; 

// check if a new region ID was assigned, 
if ( current_id == next_id ) 

// increment the next available ID 
• next_id .=■ next_id + -1; ( ."' - ' • 

// record the starting line " * • ' 

topmost___line [eurrent__id] = i; 

,. . • ' } ' ; . . ' V i; • . 5 . - ■ : 

.. . // record the lowest stick number for this region 

// min (•) is . a function that' returns the minimum of its 
// arguments'. 

lef tmo.st_stick [current_id] = . . . : 

min ( lef tmost^stick [current_id] , j ) ; . 

// accumulate moments for this region 

// DotProduct ( ) is a function that returns the inner 
product of . '.' • 

■ // two vectors that are each StickSize in length. 
momentOO [current_id] = moment 00[ cur rent__id] + 
DotProduct (class__vector , weightsOO [1] [ j ] ) ; 
.momentlO [current_id] = momentlO [current_id] + 
DotProduct (class_vector f weightslO [i] [ j ] ) ; 
momentOl [current_id] - momentOl [current_id] + 

. Do.tProduct (class_vector, weightsOl [ i] [j]); 
moment20 [current_id] - moment20 [current_id] f- 

Dot Pr oduct (class_vect or f weight s20 [i] [j ]); ■ 
moment02 [current_id] = moment02 [current__id] + 

DotProduct (class_vector , weights02 [i] [ j ] )/; 
moment 11 [current id] = momentll [current_id] + 
DotProduct. (class_vector , weightsll [i] [j]); 

• } : , • 

} . 
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APPENDIX II 
Copyright (c) 2003 Shoestring Research, LLC 
All Rights Reserved 



// loop over image lines' 

for ( int i = 0; i < ImageHeight ; ++i ) 

{ . ■, 

// loop over sticks in the line 

for (int j = 0; j < ImageWidth/StickSize ; ++j ) 

7/ loop over pixels in the stick 

for ( int k = 0; k < StickSize; ++k ) 

{ ' . 

// map coordinates into camera space 

// The corners and center of the 1x1 square centered at 
// ( j *StickS'ize + k,i) are mapped into camera space. 
Coord2D is a 

// type that holds a 2D coordinate. MapImageToCamera ( ) 

Is a . 

//. function that applies the camera model to convert 
coordinates - 

// from image space (line and pixel indices) 'into the 
canonical- 

// calibrated coordinate system. See [Tsai 86] for the 
standard ' 

// reference on camera calibration, 
const Coord2D v =? ■ 



' MapImageToCamera ( ( j *StickSize 


+ ' 


k) , 












const Coord2D vOO = 


















MapImageToCamera ( ( j *StickSize 


+ 


k) - 


0. 


.5, 


i - 


0. 


. 5) ; 


const Coord2D vlO = 


















. MapImageToCamera ( ( j * StickSize 


+ 


k) +• 


0. 


.5, 


i - 


0. 


.5) ; 


const Coord2D vOl = 


















MapImageToCamera ( (j*StickSize 


+ 


k) - 


0. 


.5, 


i + 


0. 


. 5) ; 


const Coord2D vll - 


















MapImageToCamera ( ( j ■ 


^StickSize 




k) . + 


0. 


.5, 


i + 


0. 


.5) / 



// compute moment multipliers 

// QuadrilateralArea ( ) is a function that returns the 
area of a 

// quadrilateral defined by the four 2D coordinate 
arguments 

• // Bretschneidcr 1 s formula (among others in geometry 
texts), can 

// be used to implement such a function. 
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weight sOO [i] [j] [k] - 

. weightslO [i] [j] [k] - 

weightsOl [i] [ j ] [k] = 

weights20 [I] [ j] [k] = 

weights02 [i] [ j] [k] = 

: weights 11 Li] [j] [k] = 
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Quadrilateral Area ( vOO , vlO , vOl , vll ) ; 
v.x*weightsOO [i] [j] [k] ; 
v.y*weightsOO [i] [ j ] [k] ; 
v.x*weightslO [i] [j ]'[k]; 
v.y*weights01[i] [j] [k] ; 
v.y*weightslO [i] [j ] [k] ; • 
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